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PROBLEM TO BE SOLVED: To save labor for 
troublesome teaching work and calibration and aDow easy 
work for objects, as predetermined. 

SOLUTION: In teaching work, a robot controller 5 stores 
a position Pd of a gripper 3 in the state of gripping 
the object 11 and further stores any position (Ps) after 
the object 11 is released. In clamping work, the robot 
controller 5 makes the gripper 3 follow the object 11 
being carried, go to the object 11 in accordance with 
the positions Ps, Pd and grip the object 11. 
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actual (tj) Srfig§^i»K^^-yS:4fi£-ri.. 

mttf&Bm&^f-yKcb'mxo^miz* ojbm-* 

ZbtfTZZ. 

[006 1 3 ttz. D^7h3yho-75fi P 0 # 
»«5fi«W-fcOfc:«iaT 0 £5W& k LX . JaT<0*K 

[00 623 

P a = P (t,) +P 0 + V actual (t,) ■ T 0 



V= ( t x t y t z &), 



&m<7 WUV ( t + A t ) 14, sSJ ( 4 ) 

s. 

[00533 
[»4 3 



(4) 



[00553 
[&53 

-V(t) 



(S) 



■tfV*Tn#<yh7-A4fcWW4. C*l(CJ:9: 01 

i fc^-«t 3 ic, #3t<agp ( t , ) frt>nm» 1 1 £ 

HSfr^SffiMP.fcoiKv Hf5fc (^'J -y^3 ) 

&b. xfyrSTisc^l.. 
[006 33 Xf'/7ST1 8«£*$Wt, O^yhay 

[00643 &±0>X 0 fc, o#>y h£S<4, ftiHBR 
f$fc*>tt&n#>y h^StftSPs. PdfcBttU ty'z 
T/l^-tffcJ: -3T«iiM»*>fl*ft 1 1 fcfcfl&U * L 
tD,f7 h*5fe{i§Ps. Pd£J8tvc*«t»jl l*tfE» 
ft*Srfr 3 -I;h.fc:4 9. d,-K 7 ^1 

{4, 1im*<r)*tmil lW&HmizmtZti&Zk.*: 

m> 1 1 fcgSfcflaW* ZbWZh. 
[0065] itz. ±ieo^-y h§£g{4. *<0f£E{£ 
CCD^7l. ^U-y^3a^^l IfflSra 

c c dx?^< 7 i co^mtkfttf&it ttzm^x-h-yx t> . 
±j&uz£o%&m%mkim<D*.x\ mm^mm 
i i£ffl^-rs^t* { T*i=i.. mtimzm* 

5n#7Mlt. CCD*^51. ^'J-y^'3T'H3SL 
idk Lfzi%&$>. ^m-t^nmn l 1 3&*»flrS«^ 

[0066] iixfc 4 0 , 3T^P-^{4. fi!*0|S^^ 

m. ya?j$y7iz}mzn$iz*mzmm-&zb 
1 1 icsa!*<4 txh. mmznm-t $> c t 

4. 

[00671 iaLfcSOtOWJBfli. oiK-y h 
KBtt. ay^riOtioTKiSiSaXTV^JMMlii 

mm>i i&imt&igr&i>mmiz-t&zbwx'$ 
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[00683 mmmxu. i7t^txf77STi 

4tCfcWt\ M£<? h>l>E ( t ) tf+MZ'b%<%^ 

actual 

[00 69] Ltiifi-iX. ^T77ST1 7fc*>WC. 

T*MM» 1 1 SrffiJTf S i h . T%*yh. fflft 

[0070] P a = P (tj) +P 0 

^»TO#v hr-A4£MffU 70 v'*3lzX Of? 
jhl/CV^Wfcftl lC0imZ'470ZttfX'%?>. 

[0071] m2<omM<7>Bm) ore *^«om 

[ o o 7 2 ] s i wmmmnvits m&><nmmt 
n* -y h^5tfi[gpi:^ffl«e<i^{asra«*^ m^wm 

mm^^x»mtii. ztiizttix. m2comm<o 



z t iz^xim-rz> . 

[ 0 0 7 3 ] Z ZX\ fef&Ktti: tt. ffl*MfcMHH**- 
T'jII&L,'CV>|,^-C'(i, a#>y h^fcftfiPtfiSjgV 

■5. 

[0074] r^je^^j n #. y h^5tffis 

p tttmvsb cowttw%mmmmw-mmp 0 e>t tx- 
-imffiMffiLx^2>#m. ~r%fr*>%<7fiimmcD*tL 
t>cr>mm%&wffl® t m i iz% x ^zvm t \ * a . 

i^fflttft&ftHIJ8$a { -saiP' o (*P 0 ) <v&£X' 

-ymmmwiix^&vm. -t%t>*>a#v i>¥ft{as 

Pfc«^li:<0S-Cffi«W^{aS«0SKt{i=5rv^, it* 

02o<7)#JS(Kovvc. BftttSL n#.yhiBfc{iS 
P. o*-y h#5fcftBP?)»£, ntf-y h^ftftgPco 

[00753 
[iSl] 



a? to 














MB 






H£ 




%S 






tog 


as 


MS 


» It 


»'J> 


-5E 
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-5? 
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0>J> 




— S 
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-m 


















-m 


-5P 









[00763 r^je^tt^ j -cjj, o^-y t^ftftS 
P fcttS»ffl#fi<FS:{iEWffi{i P 0 X'h *) . L#>t „ 

u >y h ^ st&a p ti*^ t i§i t aarcBiw-* . - 

[ 0 0 7 7 3 r*Sfefeiimf§ j «c«> , ojK v h 

U o^<yb#5tfiSPtM^fcOfflM«^ara^ 
P' 0 ^ ^f^Kf^fiSM^Pofcti^S. Wit* 
HI 2 (A) KTjrf iifi!ra%B$0^^1 lO 

5ttosps^as(±. iai 3(c*-r.t-5(^ ±#<^o 
t^&. 012 <b) izvk-txdiz, &mm<7>*t$m 
i lowmt, Bmwmzmixmfcco-rtizmttttz 



X^&. 

[0078] zzx\ ffl^aaw^p' otftTjk-r&z 

ktfX'Ztiti, 01 2 (C) dK. r ^iafi! 

» t^< m-rm&znz z t tfx-z h . =5rfc\ 
[007 9] mm-sVmBasmwm) nm^mx- 

tiJJ&ati, 03tc*^r-yrST6cO«iat|nl«-Cft 
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[ 0 0 8 0 ] -P#'tC. i3t:St^f'/7STl^U 
TvT ST 3 tX'OWm&'frfrtl. 7V •y>t3ttffiK«> 
QM (ntf«y H#$fcftgPs> ^ift$-ti:^itS. ntf 

^N"30{aB£o;tf-y h^ftfiap' sfc-TS. *L 

aMJsawfflp' o (=p' s-'Pd) mhuu 

aBMMaWrWP' o 

[00 8 1 J «M»ft«Cli, ft l <0K*^»B«Bfc RMK 
fc, l7t*tXf77STl 1M^T77ST18 

S»F ' i&t/fiiS^^^iJP " o * Jflvtfitf J: 
[0082] JjLt<0«fc d fc, m2a%tta$JB&ffi*n 

xvhmwizxtitf. vxvb&mmpifimmi i 

[00 83 J (m3<0H6fe<0^)miR^2O||{fi 
onMTCti. -Mk LXffi±MM. %mW®M®)<nW)i$ 

nawa-rfc , m i commnBBk mmiz, a 7 k^-t 

X-f-y 7ST1 lKXfvrSTl 7£T'<D*!yi**fi : 
*xftl>. 

[0084] JMWWUi. ^ADagiSISaMftcr)^-, n 
!jJ 7 h3>'ho-55li. BtSP^M'E (t)**-HJ- 
<*-»fc«rJflt , fcfcWC. otf-y h^5fe{2SP 
1 HzMLX^MmtzPoh^itP' o^HM. 

izmwztitzkWfeb. zvmit^ov 

actual ( ti ) k. #5fc&03&&ac C actual ( t, ) 3&»A> 
±J«Sft£3&gj£#V eatioate (t) P 0 £SVMi 

p ' 0 J: t )£.&ztizm&m$mk tmh&b-tttzmg 

.( t, ) 6>6*fftft 1 1 fcfiSfiU 7^*3tcJ: 9*t 
•Ml l^ffi^S-^d. 

[0085] -t%fr*>. n^ 7 h3>hn-55ll 0 

5t^aPs*>4>P 0 ^W; <y<rC3£»IW* J: 3 lz® 
Wth. ftii. n^>y hrjyhn-75(i. <Itf)fc#P 
o^•ffl^l!)-f•i>^mlaT , 0 *5W-6i:LTs JSIT<0 

[0086] 
[3R6] 

rV 

Pa = P(t,) + P 0 +V Ktual (ti) -V+ / (t)dt 

J o 

[ 0 0 8 7 ] =5rfc, J^Ufc^O#JirCtt, *f»ft£ 



n o mm o msx-h^x t mmiz Lxm-tz <r 

[0088] 

[^<oS&m] #f&W;:$&o*>y hSgS&tft-OMff 
^(cifttf. :*^-*tt. &^ff3l£LT. &<92 

mzkZ'ftotmx-Siw muz, mmm&mio 
fev^ie»««S5-m2^5fe{4s^-c^l6$-<i-s. z\<r> 

k%tm%i\h&l%.Vm2<?)^m.W*?. m2cott 

xztiztm-thtzwzm^htih. *iu 
[Hi ] *^<omi <^m^»»K(»4D#v h^a 

[03 3 a#yh&Wcr^Kimizt5V&W£ft®i* 

-fyu-^-^-Yx-hh. 

[05] ^imiza^x. ft&VaZW-AUzkZ 

onjKy h^JfefiaPsSr^-rsaBSW^WfiKSr^S-C* 

[06] ^imiz&lf&ttvcoMmWi&Zfik-tMX' 

[07] n^«y hga^ftl^H^tfctt^^a^S:^ 
•f7n— 1-c-hX'bh. 

[08] JE^RKtiV^, ^P<7*^^5J)fi^l» 

[09] fflftf^fcfelt**>5<»WMiB***^H-C 
[010] ^Jt^Cfc^a^-yh^^aP (t,) 

si^us^ffi^^ h^v actual ( t, ) zmwt htz 
thvmx-foh. 

[0ii] nm>*?m-thk zovmzwiw-tzmx' 

[012 3 m2cr)mm<r>BBt l zi&&a#-y h^Blcfc^ 
0T'*>l>. 

[013] n--J<-y h^5tffiBPC0iSS^ffl^ h/UV 
(t) fcRW&HT»6. 

[0 1 4 ] 3<r>mmcommizmh n^-y 

h. 
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7ny h^-i/<7)Wt% 



F^-A(##) 3F059 BC07 BC09 CA05 DA02 DA05 
DA08 DB04 DB09 DD01 DE02 
FA01 FA03 FA05 FA10 FB01 
FB16 FB22 FC04 FC13 FC14 
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